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Abstract —This paper studies path synthesis for nonholo¬ 
nomic mohUe robots moving in two-dimensional space. We 
first address the problem of interpolating paths expressed as 
sequences of straight line segments, such as those produced 
by some planning algorithms, into smooth cnrves that can be 
followed without stopping. Our solution has the advantage of 
being simpler than other existing approaches, and has a low 
compntational cost that allows a real-time implementation. It 
prodnces discretized paths on which curvatnre and variation 
of curvatnre are bounded at all points, and preserves obstacle 
clearance. Then, we consider the problem of computing a time- 
optimal speed profile for snch paths. We Introduce an algorithm 
that solves this problem in linear time, and that is able to 
take into account a broader class of physical constraints than 
other solutions. Onr contributions have been implemented and 
evaluated in the framework of the Eurobot contest. 

I. Introduction 

The general problem of moving a mobile robot as fast as 
possible from a configuration to another while avoiding a 
given set of obstacles can be tackled by several methods, 
such as cell decomposition [3], roadmap [6], and potential 
field techniques [5]. In two-dimensional planar space, a 
large number of planning algorithms produce paths that are 
expressed as broken lines, i.e., sequences of straight line 
segments, between the initial and final configurations. 

A differential-drive robot cannot follow such a path with¬ 
out stopping at the junction points between adjacent line 
segments in order to change its orientation, which wastes 
time. This problem can be alleviated by interpolating broken 
lines into smooth curves along which the orientation of 
the robot and the curvature remain continuous everywhere. 
This paper first addresses the problem of computing such 
interpolations, so as to obtain paths that can be physically 
followed without the need for stopping or slowing down 
excessively. We consider the case of differential-drive robots, 
but our results also apply to tricycle or car-like platforms. 
We develop an interpolation algorithm that guarantees that 
the obstacles cleared by a broken line are avoided as well 
by the resulting smoothed out path. 

Once an interpolated path has been obtained, we then 
address another problem which consists in computing a time- 
optimal speed profile for it, i.e., associating each point of 
the curve with a timestamp that provides the instant at 
which it will be visited, in such a way that the total time 
needed for following the path becomes as small as possible. 
This computation has to take into account various physical 
constraints of the robot, e.g., bounds on its velocity or 
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acceleration measured at its wheels or its center of mass, 
limits imposed by the steering mechanism, ... Some of these 
constraints may be context-sensitive, e.g., a tight speed bound 
may be imposed in the vicinity of obstacles cleared by a 
small margin, or steering constraints may be expressed as a 
function of the robot velocity. 

Our motivation for studying these problems originates 
from our participation to the Eurobo|^ contest, in which 
autonomous mobile robots compete in a short-duration game 
played on a 2 x 3m^ area. For this application, it is 
essential to plan paths in real-time due to the dynamic 
nature of obstacles, which practically requires a method 
with a computational cost limited to milliseconds of CPU 
time, as well as to obtain trajectories that minimize the 
time needed for moving the robot from one configuration to 
another. This prompted the development of a time-optimal 
speed profile computation algorithm that takes into account 
all the relevant physical constraints, such as those limiting 
traction at the robot wheels, or needed for ensuring stability 
in turns. Another requirement that is specific to the Eurobot 
application is to receive detailed and precise information 
about the locations that will be visited by the robot and their 
associated timestamps before starting to follow a trajectory, 
in order to be able to coordinate complex actions such as 
actuations carried out when the robot is moving, or jointly 
performed by two partner robots. While other approaches 
such as [7] and [8] have been proposed to deal with some 
of these requirements, our solutions are, to the best of 
our knowledge, the first ones that meet all of them in a 
satisfactory way. Our algorithms have been implemented and 
evaluated in the robots that we have built for Eurobot since 
2008, which amounts to hundreds of thousands of trajectories 
successfully synthesized. 

II. Problems Statement 
A. Interpolation Problem 

The first problem that we consider consists of smoothing 
out a path expressed as a broken line. We define a broken 
line path as a sequence pQ,pi,.. .pn of points, with n > 1, 
such that 

• each point pi, with i G [0, n] is defined by its coordi¬ 
nates {xi,yi) in two-dimensional space, and 

• each intermediate point pi, with i G [l,n — 1], is asso¬ 
ciated with a clearance parameter ci G K>o U {-l-oo}. 

The path is composed of the successive straight line 
segments [po,pi], [pi,P 2 ], ■■■, [pn-i,Pn]- In order to deal 
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Fig. 1. Safe zone between adjacent segments 


with obstacles, we assume that robots have zero measure, 
in other words, that a path clears a set of obstacles iff 
the intersection between its line segments and the union 
of all these obstacles is empty. (The case of robots with 
a cylindrical geometry can straightforwardly be handled by 
dilating obstacles.) The purpose of the clearance parameter Ci 
is to provide additional information about the location of the 
obstacles that are avoided when moving along the segments 
and [pi,pi+i]. This is achieved by considering a 
disk Di that is tangent to both segments (which implies that 
its center belongs to the inner bisector of the angle formed by 
these segments), and that fully covers the obstacles cleared 
by the pair of segments. This latter property precisely means 
that the area located between the disk Di and the segments 
and [pi^pi+i] is free from obstacles; we call this 
area the safe zone of this pair of segments. (By extension, we 
consider that the segments themselves also belong to their 
safe zone.) The point is that any interpolation of the path that 
is confined to safe zones is guaranteed to avoid obstacles. 
The safe zone across pi is characterized by the parameter Ci, 
defined as the distance between pi and the points of tangency 
between Di and the segments [pi-i,pi] and [pi,pi+i]. This 
parameter may be left undehned (ci = +oo), in which case 
its value can be replaced by the smallest of the lengths of the 
two segments. (In other words, Di is then the largest disk 
simultaneously tangent to both segments.) An illustration is 
provided in Figure [T] 

For each i G [1, n — 1], we dehne f3i as the angle between 
the vectors Pi-ipl and piPi^l, which corresponds to the 
change in orientation of the robot when it moves from the 
segment [pi-i,pi] to the segment [pi^pi+i\. Without loss of 
generality, we assume /3j ^ 0. It is also natural to impose 
an upper bound on \f3i\. Indeed, with a large value of /3i, 
the segments [pi_i,pi] and [pi^pi+i] can be followed in 
opposite directions, and it is not always appropriate in such 
cases to interpolate the path into one that remains close to 
the segments. In this work, we arbitrarily impose the upper 
bound \l3i\ < -n 12 for all i G [1, n—1]. In the case of adjacent 
segments forming an acute angle, it then becomes necessary 
to interleave an intermediate segment between them. 

A differential-drive robot subject to physical constraints 
cannot follow a broken line path without stopping at junction 
points. Such constraints usually take the form of lower and 
upper bounds on the velocity and acceleration of the robot 
measured at specific locations, such as its individual wheels. 


center of mass, or other reference centers. The speed that 
can be reached by the robot at some point of a path is then 
bounded by a function of the absolute curvature |k| at this 
point, as well as the rate of variation \dK./ds\ of this curvature 
with respect to the linear traveled distance. 

We are now ready to dehne precisely the interpolation 
problem. Given a broken line path, the goal is to compute 
a curve that leads from its origin to its endpoint staying 
within safe zones, and such that the absolute curvature and 
variation of curvature remain small at all points. For our 
intended applications, it is essential to be able to carry out 
this operation with a low computational cost. Finally, one 
must be able to discretize the resulting interpolated path. This 
discretization must be physically sound, in the sense that the 
discretized values of the physical variables of interest (such 
as speeds and accelerations) must remain close to their actual 
value. 

B. Speed Profile Problem 

The second problem that we address takes as input a 
discretized path, expressed as a sequence of conhgurations 
{xi,yi,9i) successively visited by a robot, where {xi,yi) 
denotes the two-dimensional coordinates of its reference 
center, and 6i its absolute orientation. In addition, some 
number of physical constraints that need to be satisfied at 
all times are provided, such as lower and upper bounds 
on the velocity or acceleration of individual wheels, the 
speed, angular speed, and tangential and radial accelerations 
measured at the center of mass or some other reference 
points, on the rate of variation of the steering angle for 
a tricycle robot, ... Some of those constraints may be 
context-sensitive, such as imposing tighter speed bounds in 
the vicinity of some obstacles, or expressing the admissible 
angular velocity of the steering wheel as a function of the 
robot speed. Besides those constraints, the initial speed of the 
robot is specified at the origin of the path, together with an 
upper bound on the speed that can be reached at its endpoint. 
Given a path and a set of physical constraints, the aim is to 
compute for all visited configurations {xi, yi,9i) a timestamp 
ti that dehnes the time at which this conhguration will be 
reached, starting from Iq = 0. The goal is to obtain the speed 
prohle that minimizes the total time needed for following the 
path, while satisfying the physical constraints at all times. 

III. Path Interpolation 

We solve the interpolation problem in two steps, the 
hrst one being aimed at producing a path in which the 
absolute curvature is bounded at all points, and the second 
one modifying this path in order to now bound the rate of 
variation of curvature. In both steps, the interpolated path 
has to stay within safe zones in order to clear obstacles. 

A. Bounding Curvature 

In order to bound absolute curvature, we build a curve 
composed of straight line segments (with zero curvature) and 
circle arcs (with constant curvature), connected in such a way 
that continuity of the tangent vector is ensured everywhere. 





Fig. 2. Segments tangent to a common circle 


On such a curve, the curvature can be expressed as a 
piecewise constant function with respect to traveled distance. 

We construct such a curve by computing, for each pair of 
adjacent segments ([pi-i,Pi], [Pi,Pi+i]) ^ value specifying 
the distance from pt at which the curve transitions from the 
segments to a circle arc. In other words, £i corresponds to 
the distance between pi and each point of tangency between 
that circle arc and the segments. 

Of course, in order to clear obstacles, it is necessary 
to have ii < Ci for all i G [l,n — 1]. We compute 
£i by applying the following principle: If three or more 
consecutive segments are all tangent to a common circle, then 
the arcs that interpolate these segments must belong to that 
circle, provided that they are located within safe zones. This 
solution has the desirable property of keeping the curvature 
constant across two or more interpolation steps. 

We now show how to carry out this computation. Consider 
a path in which all segments are tangent to a common circle 
of radius r. This situation is illustrated in Figure At the 
points Pi and Pi+i, one has respectively £i = r\ tan(/?i/2)| 
and £ij^\ = r\ tan(/3i_|_i/2)|. Since, in this case, the constraint 
£i + £i+i = \piPi+i \ is satisfied, we obtain 


£^ 

£i+l 


_ Tj \p^Pi+l\ 

Ti + Ti+i 

A+1 \PiPz+l\ 

Ti + Ti+l 


( 1 ) 

( 2 ) 


where Ti = \ tan(/3i/2)| for all i. Note that these expressions 
do not involve r, and that Equation (1) can be rewritten at 
the point pi into 

n \Pi-iPi\ 


£i = 


n-i + Tj 


(3) 


For general paths, successive segments are not tangent to 
a common circle, and Equations (1) and (3) then provide 
different values for £i. Our strategy is, for all* S [1, n — 1], 
to define £i as the smallest value among those expressed by 
Equations (1) and (3), and the clearance parameter Ci. This 
solution also applies to pairs of adjacent segments that turn 
in opposite directions; in such a case, small values of |/3i| 
(which represent small changes of direction) lead to small 
circle arcs, and large values of |/3i| to large arcs, which is 
geometrically sound. 


B. Bounding Curvature Variations 

We now turn to the problem of modifying the path 
produced at the previous step, which has a curvature that 


is piecewise constant, into one in which the rate of varia¬ 
tion of curvature with respect to traveled distance remains 
bounded. Clearing obstacles is achieved by constraining the 
interpolation to remain within safe zones. The resulting path 
must have a curvature that is continuous, bounded, and of 
bounded slope, at all points. 

We construct such curves out of clothoids, which cor¬ 
respond to the paths followed by differential-drive robots 
when their wheels are driven at respectively their minimum 
and maximum acceleration (as a result, for instance, of 
bang-bang control). Clothoids are formally defined as curves 
with a curvature that varies linearly with traveled distance. 
The coordinates of the points visited by a clothoid are 
expressed in terms of Fresnel integrals, which cannot be 
evaluated analytically, but for which very efficient numerical 
approximations are known [12]. 

Consider a circle arc with curvature kq, interpolating two 
successive line segments [pi-i,pi] and [pi^pi+i] within their 
safe zone. Assuming w.l.o.g. kc > 0 (the case kc < 0 is 
handled symmetrically), we have established the following 
result. 

Theorem 1: For every curvatures /ci,K 2 such that 0 < 
Ki < Kc and 0 < K 2 < kq, there exist two clothoids 
arcs moving respectively from the curvatures ki to km 
and from km to K 2 , with km > ttc, the concatenation of 
which interpolates the path from pi_i to within the safe 
zone, with continuity of the tangent vector at the junction 
point between the two curves. The parameters of these two 
clothoids arcs are uniquely determined by ki, K 2 , kc, and 
the rotation angle f3i. 

Our method for characterizing the two clothoid arcs con¬ 
sists in reasoning on a diagram expressing the curvature 
of the interpolated path as a function of traveled distance. 
The problem is illustrated in Figure (exaggerating the 
curvatures in order to make the interpolated path stand out 
from the circle arc). Let sm denote the distance traveled 
along the first arc, and sp the total distance traveled over 
both arcs. The linear rate of variation of curvature for 
these arcs are respectively denoted by di and —c? 2 . In the 
graph depicted in Figure [^b), the area below the curvature 
line must be equal to Pi. Note that sm and km can be 
expressed in terms of the other variables, since one has 
KM = Kl + diSM = K2+ d2{sF “ Sm)- 

It thus remains to compute di, d 2 and sp given ki, K 2 and 
Pi. We solve this problem numerically, observing empirically 
that the initial estimate 


^ - 1 _l_ ~ 

Sm kc — K2 

leads to very fast convergence with Newton-Raphson’s 
method. In practice, we first perform a variable change 
operation by defining 


di — ^2 
di + d2 


and 


d = 


di + d2 
2 


and then carry out the search over the variables sp, a, and 
d. Intuitively, a is a measure of the asymmetry between 
the two clothoids arcs, and remains small when ki and K 2 
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Fig. 3. Interpolation with two clothoid arcs 


are reasonably balanced. The value of sp is confined to an 
interval with a lower bound ^ijnc equal to the distance 
traveled on the circle arc. Its upper bound corresponds to 
the minimum value among 

2 . /3z , A 

— tan — and — 

Kc 2 min(Ki,K2) 

which respectively correspond to the combined length of the 
line segments, and the largest distance that can be traveled 
without lowering the curvature below ki and ki. It is also 
worth mentioning that, in the particular case ki = K 2 = 0, 
this procedure can be simplified into one that does not rely on 
approximations [1], except for evaluating Fresnel integrals. 

Finally, in order to apply Theorem [T] it remains to choose 
values for ki and K 2 at the extremities of interpolated curves. 
We use the following strategy: 

• At the junction between a straight line segment and an 
arc, or between two arcs turning in opposite directions, 
a natural choice is Ki = 0. 

• If we need to connect two arcs turning in the same 
direction, with respective curvatures kci and kc 2 which 
we assume w.l.o.g. to be positive, we have to choose a 
curvature Ki that satisfies Ki < mva.{Kci, 1 ^ 02 )- This 
can be achieved by defining Ki = f mm{Kci, KC 2 ), 
where 0 < / < 1 is a reduction factor that can be 
arbitrarily chosen. For the Eurobot application, we have 
observed that selecting / = 0.70 leads to paths along 
which both the curvature and variation of curvature stay 
within acceptable bounds. 

IV. Speed Profile Computation 

Before addressing the computation of a speed profile for 
a given path, we need to define the formalism in which 
such paths are represented. As explained in Section |II-B[ 
a discretized path takes the form of a sequence (ccojt/oAo)^ 


{xi,yi,9i), ..., {Xm,ym,9m) of successive configurations 
of the robot sampled at indices ranging from 0 to m. The 
discretization step between these configurations is usually 
much finer than for specifying the broken lines that are 


input to the interpolation procedure described in Section III 


(In the Eurobot application, the clothoid arcs synthesized 
by this procedure are each typically discretized into dozens 
of intermediate configurations.) This strategy differs from 
methods such as [7] and [13], in which curves are represented 
in analytic form. The advantages of our approach are that dis¬ 
cretized trajectories can be handled with much simpler data 
structures, are not limited to curves that admit an analytic 
form, and are less subject to numerical issues. We stress the 
fact that the speed profile computation algorithm discussed 
in this section is not restricted to the paths considered in 
Section]^ but is applicable to arbitrary curves, in particular 
to those produced by techniques such as [13]. 

Let us now discuss the precise semantics of discretized 
paths. Between a configuration {xi,yi,9i) and its succes¬ 
sor {xi+i,yi+i,9ipi), we consider that the robot moves 
along a circle arc, increasing its orientation by the angle 
Si = A+i — 9i, which is usually small in the case of fine 
discretization. This circle arc is fully characterized by the 
angle Si together with the chord length 


A* = \/ {Xi+i - Xj)2 -I- (j/i+i - yi)"^. 


The curvature Ki at this step thus satisfies 

2 . S, 

Kj = — sin —. 

Ai L 

For the sake of simplicity, and in order to be able to easily 
chain paths together, we impose this curvature to be zero at 
the origin and endpoint of all paths. 

Recall that the aim is to obtain a speed profile for a 
given path that minimizes the total time needed for following 
this path. We build such a profile by computing the largest 
possible value for the speed of the robot at each index 
from 0 to TO. This speed can potentially be measured at 
various locations on the robot, such as its center of mass, its 
wheels, ... For differential-drive, tricycle or car-like robots, 
all those speeds can be expressed as functions of a single 
parameter and the geometry of the path. A natural choice 
would be to define this parameter as the speed of the robot 
measured at its center which, in the case of differential-drive 
robot, is defined as the midpoint of the line segment linking 
the two locomotion wheels. This solution turns out to be 
problematic for reasoning about parts of paths where the 
absolute curvature is high, which intuitively corresponds to 
rotations of the robot around its center. In such a case, even 
though the robot is in motion, its center moves only slowly, 
or not at all. 

We choose instead to express all speeds of interest in terms 
of a parameter Zi that we call the velocity at the current 
index i of the path, defined as the quadratic mean of the 
respective speeds vu and vm of the left and right wheels of 















the differential drive: 




2 

Li 


+ V 


2 

Ri 


This parameter has the advantage of being always positive, 
and nonzero whenever the robot is not stationary. Knowing 
the geometry of the robot, one can easily compute the speeds 
at its center, center of mass, individual wheels, or other 
locations of interest, from the velocity Zi and the curvature 
Ki at the current path index. When the curvature is zero, such 
as at the extremities of paths, all those speeds become equal 
to z^. 

This reduces the speed profile computation problem to 
determining, for each index i, the highest possible velocity 
Zi at that point. Note that one cannot realistically assume 
that this velocity remains constant when the robot follows 
the circle arc from {xi,yi,9i) to {xi+i,yi+i,0i+i). Indeed, 
the speed of the robot would then be discontinuous at 
the junction points between adjacent arcs, which would 
complicate the handling of acceleration constraints. 

A better solution is to consider that, between the indices 
i and i + 1, the velocity varies linearly from Zi to Zi+i with 
respect to traveled distance. With this assumption, all the 
accelerations of interest (such as those measured at individual 
wheels, at the center of mass or other locations, in the 
tangential or radial directions, ...) can be derived from the 
values of Zi, 2 ^+ 1 , and Ki, and take at all locations values 
that accurately approximate those of the underlying (undis¬ 
cretized) curve, assuming a sufficiently fine discretization. 

The physical constraints imposed on the robot can be 
classified in two groups. We first have constraints that 
translate into an upper bound on the velocity Zi at a path 
index i. Let us illustrate this situation with a simple example. 
Assume that the speeds vm and VLi measured at respectively 
the right and the left wheels of the differential drive (in the 
forward direction) are constrained to belong to the interval 
[-Vimax,Vi^ax] at the path index i, with Vimax > 0. 
Expressing the wheel speeds in terms of Zi, we obtain 
VRi = -Ziv/2 sinwi and VLi = Zi'/^ cos uJi, where coi is 
defined as the angle that satisfies 

1 + ^ TT StT 

tana;^ = - - < Wi < —, 

and e is the distance between the wheels. The relations 
between vm, vli, Zi and uji are illustrated in Figure Our 
constraint then gives out the upper bound 


Zi < 
Zi < 


'^imax 

\/2 sinwi 

'^imax 

•\/2 coswi 


if f < < ^, 

if -f < w* < f. 


The second group of constraints contains those that involve 
the velocities Zi and Zi+i at two successive indices i and 
i + 1. This group notably includes constraints expressed in 
terms of accelerations. Let us give an example. The tangential 
acceleration experienced at the center of a differential-drive 



Fig. 4. Relations between speeds 


robot during step i is given by 


a-Ti = 




- v: 


2s,; 


where Vi denotes the speed measured at the center at the path 
index i, and Si = 5i/Ki is the distance driven during step i. 
Since we have Vi = {vm + VLi)l2 for all i, this expression 
becomes 


O'Ti — 


(sinwi+i + cosuJi+iYzLi 
4s, 


(sinwi -I- cosoji^z^ 


where oji is defined as in the previous example. One easily 
sees that imposing bounds on this acceleration amounts to 
enforcing a constraint over both Zi and Zi+i. At all every 
path index i G [0,to — 1], we denote by (j)i{zi, Zi+i) the 
conjunction of all physical constraints that jointly involve 
Zi and Zi+i. Note that constraints in both groups may be 
context-sensitive; The constraints involving Zi and zj at 
two different locations i and j can differ, or be expressed 
with respect to different values of parameters. This makes it 
possible, for instance, to impose tighter speed limits in the 
close vicinity of obstacles. 

We are now ready to describe our procedure for computing 
the fastest physically-feasible speed profile for a given path. 
This procedure has originally been introduced in [11]. It 
differs from [2], [7] by the much broader range of physical 
constraints that it supports. The algorithm proceeds in three 
stages. In the first one, it computes for every index i, the 
largest possible value Zimax allowed by the constraints of 
the first group at that point. It is also essential to make sure 
that the constraints that belong to the second group remain 
satisfiable: if Zimax is such that the constraint 4>i{zimax, Zi+i) 
does not hold for at least one Zi+i < Zi+imax, then Zimax has 
to be lowered into the largest value that makes the constraint 
satisfiable. In the same way, Zimax must be sufficiently small 
for the constraint cj)i-i{zi-i, Zimax) to be satisfiable in Zi-i. 
These operations can be carried out numerically, a simple 
strategy being to perform a binary search until the required 
precision is reached. 

After a suitable value of Zimax has been obtained at all 
indices i, the second stage assigns a tentative value to Zi for 











increasing values of i. The initial velocity zq is fixed by the 
speed of the robot specified at the origin of the path. Then 
for i = 1, 2,..we successively compute the largest value 
of Zi that is less than or equal to the upper bound Zi^ax at 
the index i, and that satisfies the constraint 
(with the value of Zi-i obtained at the previous step). 

The third and last stage performs a similar operation for 
decreasing values of i, starting from the last index m of the 
path and moving towards its origin. Before the first iteration, 
the velocity Zm at the end of the path has possibly to be 
lowered in order to satisfy the upper bound imposed on the 
final speed of the robot. Then, for i = m — l,m — 2,.. 
one successively adjusts the current value of Zi (by lowering 
it or leaving it unchanged) so as to satisfy the constraint 

4>i{Zt,Zi+i). 

After completing this stage, the computed values of Zi 
at all path indices are such that constraints of both groups 
are satisfied, and it remains to check that the computed 
initial velocity zq corresponds to the initial speed of the 
robot. In the case of a mismatch (meaning that zq had to be 
lowered during third stage), it is impossible to follow the path 
with the specified initial speed while satisfying all physical 
constraints, and the speed profile computation returns an 
error. Otherwise, one can straightforwardly compute, from 
the value of Zi at all indices and the geometry of the path, 
the instant ti at which the corresponding configurations will 
be reached. 

This technique yields a time-optimal speed profile, since 
increasing the speed of the robot at any location on the path 
would lead to violating at least one physical constraint. The 
computational cost is linear in the number of path steps, 
provided that all constraints can be solved in bounded time. 

V. Conclusions 

In this paper, we have addressed the problem of inter¬ 
polating a path expressed as a sequence of straight line 
segments into a trajectory that can be followed as fast as 
possible by a nonholonomic robot, taking into account the 
physical constraints of the robot. This problem has been well 
studied in the literature [9], [4], [10], [13], [8], [7], but our 
motivation for developing an original solution was prompted 
by the particular requirements of the Eurobot contest. In 
this setting, it is crucial to be able to plan trajectories that 
can be generated with very low computational cost, to take 
into account complex physical constraints such as those 
governing traction at individual wheels or ensuring stability 
in turns, and to provide accurate spatial and temporal advance 
information about the visited configurations. To the best of 
our knowledge, our solution is the first one that meets all 
those requirements. Compared with methods such as [14], 
[13] that also rely on clothoids for interpolating paths, our 
approach of joining only two arcs of clothoids for moving 
from one curvature to another has the advantage of being 
simpler and computationally cheaper, the trade-off being that 
the generated curves are not guaranteed to be optimal. 

The path interpolation and speed profile computation algo¬ 
rithms discussed in this paper have been implemented in the 


Discretized 

points 

Synthesis 

time 

Discretization 

time 

Speed profile 
time 

Total 

time 

292 

15.2 //s 

33.4 /Ts 

140.9 /is 

189.5 /is 

520 

29.6 /is 

53.6 /is 

239.0 /is 

322.2 /is 

632 

30.8 //s 

72.7 /TS 

303.5 fxs 

407.0 /iS 

656 

23.1 //s 

77.9 

319.1 

420.1 


Fig. 5. Experimental results 


robots built for Eurobot at the University of Liege since 2008, 
together with an original path planning algorithm. In this 
setting, they have been successfully validated on hundreds 
of thousands of trajectories, considering 16 distinct physical 
constraints of robots with differential as well as tricycle 
drive, some of them being context-sensitive; lower and upper 
bounds on the speed and acceleration of locomotion and 
steering wheels, on the speed, angular speed, tangential 
and radial accelerations at the center of mass, and on the 
angular rate of steering. In order to illustrate the efficiency 
of our method, we report in Eigure the time needed 
for running the interpolation and speed profile algorithms 
on a few sample trajectories experienced in the Eurobot 
application. We distinguish the costs of the curve synthesis, 
path discretization, and speed profile computation steps. The 
total computational cost typically amounts to less than half a 
millisecond of CPU time on a i5-460M processor running at 
2.53 GHz, which is several orders of magnitude faster than 
techniques such as [7]. 
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